INTEGRATED SENSING SYSTEM 
CROSS-REFERENCE TO RELATED APPLICATIONS 



[001] The present invention is related to provisional 

application (Attorney Docket 202-0745) entitled "Integrated 

Sensing System for an Automotive System, " filed on February 
26, 2003 and incorporated by reference herein. 

Technical Field 

[002] The present invention relates generally to a vehicle 
sensing system and, more specifically, to a system for 
controlling an automotive vehicle in response to sensed 
dynamic behavior from the sensing system. 

Background 

[003] Various automotive vehicles have recently begun 
including vehicle dynamic control systems. Such vehicle 

dynamic control systems include yaw stability control systems, 
roll stability control systems, integrated vehicle dynamic 
control systems, etc. The ongoing goal of vehicle controls is 
to achieve a coordinated system of vehicle performance for 
ride, handling, safety and fuel economy. 

[004] With current advances in mechatronics , vehicle controls 
have increased opportunities for achieving performances, which 
were previously reserved for spacecraft and aircraft. For 
example, gyro sensors, previously only used in aircraft, have 
now been incorporated in various vehicle controls, and the 
anti-lock brake systems invented for airplanes are now 
standard automotive control systems. Current sensor 

technology generates ever increasing opportunities for vehicle 
control . 
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[005] A typical vehicle control system may control up to 3- 
dimensional vehicle motions. For example, during roll 

stability control, the control system controls three- 
dimensional rotational motions along the vehicle roll, pitch, 
and yaw directions and motion along the vehicle longitudinal, 
lateral and vertical directions. Yaw control systems 

typically control yaw motion. 

[006] Different motion directions influence the motion in 
other directions. For example, excessive steering of a 
vehicle may lead to excessive yaw and lateral motion, which 
could cause large rolling motion towards the outside of a 
turn. If the driver brakes the vehicle during the excessive 
steering, the vehicle will also experience roll and pitch 
motions in conjunction with lateral and longitudinal 
accelerations. Therefore, a successful vehicle dynamics 

control should involve an accurate determination of the 
vehicle roll, pitch and yaw attitudes (side slip angle) . 

[007] Currently, inertial measurement units ( IMUs ) and various 
other sensors used in aerospace vehicle controls have been 
incorporated in automotive vehicles for inertial control . 
IMUs have been used in inertial navigation systems (INS) for 
aircrafts and satellites for decades. Typically, an INS 
system determines the attitude of a flight vehicle through IMU 
sensor signals . 

[008] An IMU sensor set includes three gyros and three linear 
accelerometers . An INS contains an IMU and a processor unit 
to compute the navigation solutions necessary for navigation, 
attitude reference and various other data communication 
sources . 

[009] Although INS systems are sufficient to generate a 
navigation solution, over time the computation based on IMU 
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sensor signals drifts, and the errors associated with the 
computation increases. Sometimes these errors increase such 
that a navigation solution is unattainable within the INS. To 
mitigate this problem and to compute a correct navigation 
solution over the entire flight, external navigation sources 
are used to continually correct the attitude computations 
based on IMU sensor signals. One of the more reliable of 
external sources is a GPS system with a single or multiple GPS 
receivers . Such a system has been used to determine a rough 
attitude reference of a vehicle in flight. 

[0010] Current automotive vehicle systems experience a similar 
signal drift problem in vehicle attitude determination. 
Although the drift is not as severe as in aerospace vehicles, 
it generates errors within the vehicle control system such 
that the vehicle control system engages improper actions . 

[0011] It would therefore be desirable to provide a vehicle 
system sensing algorithm that uses sensors to determine the 
vehicle operation states, to monitor abnormal vehicle 
operation states, and to compensate the sensor errors for 
various automotive vehicle control applications. 

Summary of the Invention 

[0012] In one aspect of the invention, a vehicle control 
system includes a housed sensor cluster generating a plurality 
of signals. The signals include a roll rate signal, a pitch 
rate signal, a yaw rate signal, a longitudinal acceleration 
signal, a lateral acceleration signal, and a vertical 
acceleration signal, 4 wheel speed sensors and a steering 
wheel angle sensor. 

[0013] An integrated controller includes a sensor signal 
compensation unit and a kinematics unit, wherein the sensor 
signal compensation unit receives at least one of the 
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plurality of signals and compensates for an offset within the 
at least one of the plurality of signals and generates a 
compensated signal as a function thereof. The integrated 
controller further generates a kinematics signal including a 
sensor frame with respect to an intermediate axis system as a 
function of the compensated signal and generates, a vehicle 
frame signal as a function of the kinematics signal. 

[0014] A dynamic system controller receives the vehicle frame 
signal and generates a dynamic control signal in response 
thereto. A safety device controller receives the dynamic 
control signal and further generates a safety device signal in 
response thereto. 

[0015] In a further aspect of the invention, a method for 
controlling a safety device for a vehicle includes generating 
a roll attitude angle of a sensor frame with respect to an 
intermediate axis system; generating a pitch attitude angle of 
the sensor frame with respect to the intermediate axis system; 
generating an x velocity component of the sensor frame with 
respect to the intermediate axis system; generating a y 
velocity component of the sensor frame with respect to the 
intermediate axis system; generating a z velocity component of 
the sensor frame with respect to the intermediate axis system; 
transferring the roll attitude angle, the pitch attitude 
angle, the x velocity component, the y velocity component, and 
the z velocity component in the sensor frame to a body fixed 
frame system as a function of sensor misalignments. 

[0016] In still a further aspect of the invention, a method 
for controlling a safety device for a vehicle includes 
transforming vehicle dynamic variables from a sensor frame to 
a body frame as a function of vehicle dynamic sensor 
misalignments; generating a roll attitude angle of the body 
frame with respect to an intermediate axis system; generating 
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a pitch attitude angle of the body frame with respect to the 
intermediate axis system; generating an x velocity component 
of the body frame with respect to the intermediate axis 
system; generating a y velocity component of the body frame 
with respect to the intermediate axis system; and generating a 
z velocity component of the body frame with respect to the 
intermediate axis system. 

[0017] Thus, the present system may be incorporated in but not 
limited to a rollover stability control system (RSC) , a yaw 
stability control system, an ABS/TCS control system and a 
power-train control system for fuel economy purpose. One 
advantage of the invention is that the sensor cluster in 
tandem with the integrated controller generates accurate 
vehicle attitude and velocity signals. More specific example 
is the vehicle longitudinal velocity. During braking or 
throttle conditions, the wheel speed signal alone would not be 
able to generate accurate vehicle reference speed 

(longitudinal velocity) which is used in wheel slip control 
for achieving RSC/TCS/ABS functions. When the wheels of one 
side of the vehicle are up in the air (due to large roll 
trending of the vehicle) , those wheel speed information are no 
longer the valid indications of the vehicle speed. In off-road 
driving, more than one wheel could behave independently of the 
vehicle speed. 

[0018] Another advantage is the substantially improved 
accuracy of current vehicle dynamics and predicted vehicle 
dynamics as used in but not limited to rollover stability 
control systems, yaw stability control systems, ABS/TCS 
control systems, power-train control systems. 

[0019] A further advantage is the substantially improved 
accuracy of the predicted road conditions on which the vehicle 
is driven. For example, the accurate identification of the 
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road inclination could help the throttle control system to cut 
unnecessary fuel consumption during down hill driving; the 
accurate identification of the road surface friction condition 
could help RSC and yaw stability control. 

[0020] Still a further advantage is the ability to identify 
the vehicle parameter changes. For example, the loading or 
mass variation of the vehicle could be identified so that 
appropriate level of control actions could be adjusted in 
proportional to the vehicle loadings. 

[0021] Another advantage is the ability to detect the sensor 
misalignment errors and sensor plausibility check. The sensor 
misalignment errors have two portions (i) the sensor mounting 
errors; (ii) the uneven loading conditions generating 
misalignment between the loading vehicle and the unloading 
vehicle. Such an identification of the sensor misalignment 
errors could substantially improve the accuracy of the 
predicted vehicle operation states. 

[0022] Another advantage is the ability to substantially 
improve the performance of the four wheel drive vehicle due to 
the accurate identification of the force and torque applied to 
the wheels. Therefore, both the command drive torque and the 
resultant torque on the wheel end can be accurately identified 
so as to increase the efficiency of the torque-on-demand 
strategy. 

[0023] Another advantage is the ability to monitor and detect 
the potential abnormal states of the vehicle including but not 
limited to tire under-inf lation, tire imbalance, suspension 
wear, tire wear, brake pad wear and steering misalignment, 
etc . 

[0024] Other objects and features of the present invention 
will become apparent when viewed in light of the detailed 
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description of the preferred embodiment and when taken in 
conjunction with the attached drawings and appended claims. 

Brief Description Of The Drawings 

[0025] Figure 1 is a diagrammatic view of a vehicle system in 
accordance with one embodiment of the present invention. 

[0026] Figure 2 is a diagrammatic view of a vehicle system in 
accordance with Figure 1 . 

[0027] Figure 3 is a diagrammatic view of a vehicle system in 
accordance with another embodiment of the present invention. 

[0028] Figure 4 is an axis system in accordance with another 
embodiment of the present invention. 

[0029] Figure 5 is an integrated sensing system in accordance 
with another embodiment of the present invention. 

[0030] Figure 6 is an integrated sensing system in accordance 
with another embodiment of the present invention. 

[0031] Figure 7 is a logic flow diagram of a method for 
controlling a vehicle dynamic system in accordance with 
another embodiment of the present invention. 

Description Of The Preferred Embodiment 

[0032] In the following Figures the same reference numerals 
will be used to identify the same components. The present 
invention is preferably used in conjunction with vehicle 
control systems, which include, but are not limited to a yaw 
stability control system, a roll stability control system, an 
integrated vehicle dynamics control system, or a total vehicle 
control system for achieving fuel economy and safety and other 
vehicle level performances . 
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[0033] The integrated system controller or integrated sensing 
system controller (ISS) in the present invention estimates and 
predicts the vehicle operation states including vehicle global 
and relative attitudes, vehicle directional velocities, forces 
and torques applied to a vehicle, etc.; generates a sensor 
plausibility check; monitors the abnormal conditions of the 
moving vehicle; and corrects the sensor mounting errors of the 
sensors. The information generated from the integrated system 
controller is used to initiate control commands for various 
control systems including, but not limited to: power-train 
controls, brake controls, steering controls, transmission 
controls, suspension controls, etc. Additional controls 

include warnings to drivers of possible abnormal conditions 
such as: tire under inflation, tire wear, and unbalanced 
tires, steering misalignment, on-line conditioning, and 
calibration of the errors in sensors due to mounting errors. 
The various functions of the ISS are detailed herein. 

[0034] Referring to Figures 1, 2, and 3, a vehicle control 
system 10 for an automotive vehicle 14 having a controller 

(here embodied as the integrated sensing system controller 12) 
is illustrated. The system 10 also includes a sensor cluster 
16 or inertial measurement unit (IMU) sensor cluster, wheel 
speed sensors 24, steering angle sensors 26, suspension height 
sensors 30, local actuator sensors 32 used by the subsystem 
controls, a dynamic system controller 33, a braking controller 
34 and various alternate vehicle actuators 36, all of which 
will be discussed in detail later. Notice that the suspension 
height sensors are not necessary for the ISS to work, some 
applications might drop them. Some modifications to the 
algorithms should be conducted in case the suspension height 
sensors are removed. 

[0035] The system components are connected in the following 
possible arrangement: the integrated system controller 12 is 
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electrically coupled to the sensor cluster 16 and various 
other vehicle sensors 24, 26, 30, 32. Signals from the 
integrated system controller 12 are received in a dynamic 
system controller 33, including the yaw stability controller 
40, the roll stability controller 42, the antilock braking 
system (ABS) controller 44, and the traction control system 
(TCS) controller 46. Signals from the dynamic system 

controller 33 are received in a braking controller 34. 
Braking controller signals are received in vehicle and vehicle 
actuators 36, such as brake calipers and braking devices. 

[0036] Referring to Figure 4, various frames of reference are 
indicated for an automotive vehicle 14 to illustrate the 
system 10. These include an inertial frame (X E ,Y E ,Z E ) body- 
fixed frame (X B ,Y B ,Z B ), an ith sensor. frame(X si/ 7 S i/2siJ, an 
average moving road plane, an Intermediate Axis System 
(X lf Y lf Z x ) f and an ith wheel frame (X w ±, Y w ±, Z W i) • 

[0037] The inertial frame (X E ,Y E ,Z E ) is a right-hand orthogonal 
axis system fixed on the earth. The X E and Y E axis are in the 
horizontal plane and Z E axis points upwards. The horizontal 
plane is sea level or the ground level . 

[0038] The body-fixed frame (X B ,Y B ,Z B ) is a right-hand 
orthogonal axis system fixed on the nominal center of gravity 
of the vehicle body 14. The X B axis is in parallel with the 
average vehicle floor but lying in the longitudinal plane of 
symmetry. Y B axis is perpendicular to the longitudinal plane 
of symmetry of the nominal vehicle body 14 and points towards 
the driver's left and Z B axis points upwards. 

[0039] The intermediate axis system (X n Y n Zj) is the axis 
system which yaws with the vehicle and whose roll and pitch 
attitudes with respect to the inertial frame are zero, and 
whose origin is the same as the inertial frame. 
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[0040] The ith sensor frame (X si/ Y si , Z s ±) is the right-hand 
orthogonal axis system where the ith group of sensors is 
assembled, or it is the ith sensor cluster fixed frame. In 
one embodiment, the axes from the ith sensor frame ( X si , Y si , Z S i ) 
coincide with the axes of the body-fixed frame (X B ,Y B ,Z B ). 
Generally, however, the sensor mounting error causes 
(X S i/ Ysif Z S i) not only to be misaligned with (X B ,Y B ,Z B ) in 
directions but also locations. 

[0041] The average moving road plane is a plane determined by 
the four centers of road-tire contact patches. If the road 
surface is perfectly flat, this plane is the road surface. If 
the four vertical coordinators of the centers of the contact 
patches, with respect to the inertia frame, are zo,z 1 ,z 2 ,z 3 for 
front-left, front-right, rear-left" and rear-right corners, 
then the average moving road plane includes the bank angle 
computed as : 

average road bank = — (— — — + — ( l ) 
4 '/ ** 

where t f and t r are the half tracks of the front and rear 
axles, and the slope is computed as: 

average road slope = — (-^ — ^- + — ( 2 ) 
2 b b 

where Jb is the vehicle wheel base. The moving road plane is 
moving and yawing with the vehicle body. The moving road 
frame is the right-hand orthogonal axis system (X R ,Y R/ Z R ) in 
which the X R Y R plane coincides with the average moving road 
plane, X R -axis being the projection of the X B axis on to the 
average moving road plane, Y R axis being the projection of the 
Y B axis on to the average moving road plane, and Z R axis points 
upwards . 



10 



[0042] The ith wheel frame (X wi/ Y wi , Z wi ) is the right-hand 
orthogonal axis system in which the Y wi axis is directed along 
the wheel spinning direction (but points to the direction of 
positive wheel angular spinning rate if the vehicle is 
traveling forward) , and the Z W i axis is perpendicular to the 
contact patch of the wheel and points upward. Therefore this 
frame is a local frame and 2=0,1,2,3 denotes the front-left, 
front-right, rear-left and rear-right wheels. 

[0043] Referring again to Figures 1 and 2, the integrated 
controller 12 includes sensing algorithms including but not 
limited to RSG 70 (reference attitude and reference 
directional velocity determinations), RPD 72 (road profile 
determination) , RAD 74 (relative attitude determination) , GAD 
76 (global attitude determination) , DVD 78 (directional 
velocity determination) , SPC 80 (sensor plausibility check) , 
ASM 82 (abnormal state monitoring) , SSC 84 (sensor signal 
compensation), FATE 86 (force and torque estimation), B2R 88 
(body-frame to road-frame transformation) , NLD 90 (normal 
loading determination), S2B 91 (sensor-frame to body-frame 
transformation) , VPD 92 (vehicle parameter determination) , and 
additional computational units 96 and 98. 

[0044] The aforementioned algorithms are included to control 
for sensor misalignments and relative attitude between the 
vehicle body and the average road surface. Both sensor 
misalignment and the relative attitude angles like relative 
roll and pitch angles are included to conduct corrections. 
The IMU sensor 16 may have offsets or low frequency bias or 
drifts, which are compensated before sending the sensor 
signals to a kinematics unit within the ISS 12, as will be 
discussed regarding Figures 5 and 6 . 

[0045] By closely checking the automotive dynamics, several 
external correction mechanisms are available including Wheel 
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Speed Alignment (WSA) , Road Constraint Alignment (RCA) , Level 
Ground Attitude Alignment (LGAA) , and Virtual Heading Angle 
Alignment (VHAA) . 

[0046] In regards to WSA, the ABS wheel speed sensor signals 
provide certain vehicle speed content which is similar to one 
of the GPS-derived velocity but measured along the road 
surface plane. The longitudinal speed can be aligned with the 
wheel speed information. 

[0047] In regards to RCA, the vehicle cannot take off from the 
road for a long period of time, hence the derivative of the 
vertical velocity of the vehicle should not have significant 
low frequency contents. It might have high frequency content 
due to road unevenness, but it should have zero value in low 
frequency range . 

[0048] In regards to LGAA, on level ground, the vehicle 
attitude can be readily obtained through the chassis attitude 
angles, namely, the angles calculated from the roll/pitch 
angular accelerations and longitudinal/lateral accelerations. 

[0049] In regard to VHAA, in automotive dynamics control, the 
vehicle absolute heading angle is not required. Hence instead 
of calculating heading angle, the computations are performed 
in the reference frame, which is yawing with vehicle while 
its origin is still fixed on the earth. In other words, the 
vehicle has heading aligned with the reference frame. 

[0050] The above four alignment conditions (WSA, RCA, LGAA and 
VHAA) provide a set replacement conditions which otherwise 
will be needed from the GPS used in Transfer Alignment. That 
is, they can be used to achieve removing the low frequency 
drift in the sensor signals. For this reason, they are a GPS- 
Replacement . 
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[0051] Figures 5 and 6 illustrate two examples of how the 
aforementioned computational units interacted with each other 
for implementing the present invention in conjunction with the 
GPS-Replacement . 

[0052] The first logic , as shown in Figure 5, includes input 
sensors 100 (IMU sensor cluster 16, the wheel speed sensors 
24, steering wheel sensor 26 and road constraint used as GPS 
replacement or external correction mechanism) , a sensor signal 
compensation unit 102, a kinematics relationship unit 104, a 
core attitude and velocity algorithm 106, various other 
computation modules 108, a sensor alignment unit 110, a 
transformation unit 88 to transform the signals defined in the 
car body frame to the signals defined in the fixed reference 
frame unit , a transformation unit 91 to transform the signals 
defined in the sensor frame to the signals defined in the body 
fixed frame, and a relative attitude determination unit 112. 

[0053] The logic in Figure 5 receives input sensor signals 
from the input sensors 100 and compensates for them in the 
sensor signal compensation unit 102 . The compensated sensor 
signals are received in the kinematics unit 104 controlling 
kinematics of sensor frame with respect to intermediate axis 
system, which shares information with the core attitude 
velocity algorithm 106. The core attitude velocity algorithm 
106, which will be discussed later, is used by the S2B 91 to 
generate a body fixed frame signal . The body fixed frame 
signal and a relative attitude determination signal from the 
relative attitude determination unit 112 are received in the 
B2R 88, which generates therefrom a reference frame signal. 
The first logic set 96 also generates various other 
compensation signals from the other computation modules 108, 
as will be discussed later. 
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[0054] In other words, the logic in Figure 5 conducts a major 
computation in the sensor axis system and uses sensor 
misalignments and an Euler transformation to transfer 
calculated variables in the sensor frame to the body fixed 
frame. For the virtual heading angle alignment (VHAA) to be 
satisfied, the reference frame is the intermediate axis 
system. 

[0055] The second logic, as shown in Figure 6, includes input 
sensors 100 (IMU sensor cluster 16, the wheel speed sensors 
24, steering wheel sensor 26, the road constraint and other 
correction mechanisms used as GPS replacement or external 
correction mechanism), a sensor signal compensation unit 102, 
a kinematics relationship unit 120, a core attitude and 
velocity algorithm 106, various other computation modules 108, 
a sensor alignment unit 110, a transformation unit 88 to 
transform the signals defined in the car body frame to the 
signals defined in the fixed reference frame unit , a 
transformation unit 91 to transform the signals defined in the 
sensor frame to the signals defined in the body fixed frame, 
and a relative attitude determination unit 112. The second 
logic set shown in Figure 6 receives input sensor signals from 
the input sensors 100 and sensor misalignment signals from 
the sensor misalignment unit 110 and converts the sensor 
signals to body fixed frame signals in the S2B 91. The body 
fixed frame signals are compensated in the sensor signal 
compensation unit 102 and received in the kinematics unit 120. 
The kinematics relationship unit 120 of the second logic set 
98 determines kinematics of the body frame with respect to an 
intermediate axis system. 

[0056] The kinematics signals are shared with the core 
attitude and velocity algorithm 106, which generates therefrom 
a core attitude velocity signal. The core attitude velocity 
signal is received in the B2R, which, along with a relative 
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attitude determination from the relative attitude unit 122, 
generates therefrom a reference frame signal . The second logic 
shown Figure 6 . also generates various other compensation 
signals from the other computation modules 108, as will be 
discussed later. 

[0057] In other words, the second logic shown Figure 6 
conducts the major computation in the body fixed frame, 
therefore the sensor signals are transformed from the sensor 
axis system to the body-fixed axis system. For the virtual 
heading angle alignment (VHAA) to be satisfied, the reference 
frame is the intermediate axis system. 

[0058] Regarding both logic set examples shown in Figure 5 and 
Figure 6, the roll and pitch attitudes of the vehicle body 14 
are related to the roll and pitch angular rate sensor signals 
through coupled interactions , rather than simple integrations 
and differentiations. Simple integrations work, however, when 
the different motions of the vehicle 14 are decoupled. 
Important to note is that the vehicle yaw motion can be 
affected by the vehicle pitch and roll motion. 

[0059] If the vehicle body roll and pitch attitudes with 
respect to the intermediate axis frame are denoted as B xB /i and 
©yB/j# then this complicated relationship can be expressed in 
the following Euler transformation: 

Oxbii = co x [co v sin(0 xB/I ) + co 7 sin(0 xb/i )] tan(0 3 «/# ) 

(3) 

6yBii = co y cos(6xbu ) + co z sin(0xB/i )] 

[0060] The relationship depicted in equation (3) reveals 
complicated nonlinear functions and it indicates that a simple 
integration of the roll rate could provide accurate 
information about the roll attitude only if: (a) both the 
pitch and yaw rate are negligible, which means the vehicle is 
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dominated by roll motion; (b) the roll attitude angle and yaw 
rate are negligible, the pitch attitude is limited; and, (c) 
the pitch attitude angle is negligible with non-extreme pitch 
and yaw rates . 

[0061] The simple integration of the pitch rate leads to 
accurate prediction of the pitch attitude angle if the roll 
attitude angle is negligible and the yaw rate is not extremely 
large . 

[0062] The aforementioned logic sets 96, 98 operate 
conditionally because the following is simultaneously true: 

0 xBIl ~ CO x , 6 yBII = CO y 

if Oxbh ~0 and 0 yB /i ~0 , or 0 x bu -Oand co y . That is, either the 

vehicle has small roll and pitch attitude angles or the 
vehicle has small roll attitude angle plus small yaw rate, 
which contradict with the purpose of using them in rollover 
and pitch-over detection, because both roll and pitch 
attitudes are large, and the vehicle usually experience 
combined roll, pitch and yaw motions. 

[0063] A direct integration for the dynamics of equation (3) 
can be formulated as the following: 

0*n (* + !) = 0*1, (*) + K (* + 1) + K (* + D sin (#*s// (*)) + ^ (* + 1) cos(^, /# (*))] tsm(fi yBU (*)) } AT 

Ojbu (* + !) = OyBu (*) + { <»j ( k + ^ cos(^ /# (*)) - ^ (* + 1) sin(^ /# (*)) } Ar 
(4) 

where AT is the sampling time of ISS 12. As mentioned before, 
this integration intends to drift due to sensor drift and 
inevitable numerical errors. As in a Transfer Alignment 
approach, the low frequency drifts are removed through signals 
from the GPS unit through the Kalman filter. 
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[0064] Included in the kinematics used in the transfer 
alignment approach is a set of equations involving the roll, 
pitch and yaw attitude angles of the sensor frame with respect 
to the Earth-fixed inertial axis system (X E ,Y E ,Z E ). 

[0065] Those attitude angles are denoted as ^xsiE^ysiE and &zs/e • 
The corresponding velocity components of the origin of sensor 
frame measured along the sensor axes but with respect to the 
Earth-fix frame are denoted as v xS/E/ v yS / E / and v zS/E . These 
equations are as follows : 

0 xs , e = COxs + (co yj sin 0xstE + coxs / e) tan 0 y , , E 
• 

d ys,E = toy* COS dxsl E — toys Sin BxslE 

m 

6 uie = (toys Sill &xs/ E + tozs COS 0xs/e) SCO 0y*/E 
• 

Vxs/E = ays - toysVv I E + tozsVys I E + g S\U 6 ys I E 

V ys I E = ays - tozsVxs I E + toxs Vzs I E — g Sill 0 xs I E COS 6 ys I E 

V zsf E = azs- toxsVys I E + toysVxs IE — g COS G xs I E COS Oys I E 

[0066] The kinematics 104 used in the first logic set 96 of 
ISS, shown in Figure 5, is a set of equations involving the 
roll, pitch and yaw attitude angles of the sensor frame with 
respect to the intermediate axis system (X 1 ,Y Z ,Z 1 ). Because 
the intermediate axis system {X x ,Y lf Z z ) yaws with the vehicle, 
therefore the VHAA is satisfied. That is, the yaw attitude of 
the sensor frame with respect to the intermediate axis system 
is close to zero. For that purpose, the yaw degree of freedom 
in ISS can be dropped. 

[0067] The corresponding attitude angles may be 0 xS /i/ S y s/i/ and 
Qzs/i/ with 9 zS/I 0 . The corresponding velocity components of the 
origin of sensor frame measured along the sensor axes but with 
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respect to the intermediate axis system {XxtYitZj) are denoted 
as v xS/I/ v yS /j 7 and v zS/J . Such a set of equations includes: 

6xs 1 1 = coxs + [coys sin 6xs / / + cozscos 0 M i /) tan 6 ys / 1 

8 ys I I — COys COS 6xs 1 1 — COzs S\X\ 6xs 1 1 

Vxs/I = (Xxs - COysVzs I I + CDzsVys I I + g SHI 0 ys I I 

V ys 1 1 — GCys — COzsVxs 1 1 + COxsVzs I I ~ g Sill Oxs I I COS Oys / / 

V zs 1 1 = CZzs - COxsVys 1 1 + COysVxs I I + g COS ^xv / / COS / / 

[0068] The intermediate system does not travel with the 
vehicle 14, therefore v xS/I #0 . Using the other alignment 
conditions, such as: WSA, RCA and LGAA, the - low frequency 
correction can be achieved. 

[0069] The kinematics 120 used in the second logic set 98, as 
illustrated in Figure 6, includes a set of equations involving 
the roll, pitch and yaw attitude angles of the body frame with 
respect to the intermediate axis system (X If Y I# Z x ). Because 
the intermediate axis system yaws with the vehicle 14, the 
VHAA is satisfied. That is, the yaw attitude of the body 
frame with respect to the intermediate axis system is equal to 
zero. For that purpose, the ISS yaw degree of freedom can be 
dropped . 

[0070] The corresponding attitude angles are denoted as G xS/I/ 
Qys/i/ and 0zs/i/ with 9 zS/I =0 . The corresponding velocity 
components of the origin of body-fixed frame measured along 
the body- fixed axes but with respect to the intermediate axis 
system are denoted as Vxb/i, v rS/J/ and v zB/I . Equations for this 
include : 
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6 xBn- coxb + ( coyb sin 0 XB n + aha cos 9xb , , ) tan 0™ / / 
6 mil — com cos / / — G)m sin 6xb » i 

V xBn = OCxb — (DybVzb i i + COzbVyb i i + g Sin / / 

V yb 1 1 — OCyb — COzbVxb i / + COxbVzb i / + g Sin 0 xb 1 1 COS / / 

V zfl / / = CCzb — COxbVyb i i + &>raVxB ft — g COS / / COS 6yb i i 

[0071] The intermediate system does not travel with the 
vehicle 14, therefore v xB/I /0 . The variables used in the 
kinematics are: 

Road Constraint Alignment: 
LPF[v zB ,k] = 0 

Wheel Speed Alignment: 

VXS tR = J COl, CO), CO*, 5, 6xS ,R,&YSIr) 

Level Ground Attitude Alignment 

SxS I I = Ox - chassis + QxS I B 
0YS I I — 0Y - chassis + 0YS I B 

[0072] These are transformed from the sensor frame to the 
body-fixed frame. That is, the sensor misalignments are 
required to be detected before the estimation. Using the 
other alignment conditions such as WSA, RCA and LGAA, the low 
frequency correction can be achieved. Those alignment 

conditions are: 

Road Constraint Alignment: 
LPF[v*,*] = 0 

Wheel Speed Alignment: 
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Vxb/r = J COi, CDi, (D*, S, 6xb 1 /?, Qm 1 r) 

Level Ground Attitude Alignment 

OxB I I = Ox - chassis 
0YB I I — 0Y - chassis 

[0073] The IMU "16 requires other sensors providing similar 
external correction mechanism to a GPS signal. By closely- 
checking the automotive dynamics, several external correction 
mechanisms are available including wheel speed alignment (WSA) 
from the wheel speed sensor 24, road constraint alignment 

(RCA) , level ground attitude alignment (LGAA) , and virtual 
heading angle alignment (VHAA) . 

[0074] The outputs of ISS 12 is also used to warn drivers for 
possible abnormal conditions such as tire under inflation and 
tire imbalanced, subsystem problems like broken suspensions, 
severe wear of the brake pads, etc. 

[0075] The outputs of the ISS will be used to activate passive 
safety devices. For example, they will be used to deploy 
side-airbags during a rollover accident. The outputs of the 
ISS will be used to optimize the fuel economy based on the 
current driving and road conditions. 

[0076] The wheel speed sensors 24 are mounted at wheel 
locations and are denoted as w //5 w^vv^, w rr for left-front 58, 

right-front 60, left-rear 62 and right-rear wheels 64 
respectively . 

[0077] The ABS wheel speed sensor signals include vehicle 
speed content, which is similar to one of the GPS-derived 
velocity but measured along the road surface plane. The 
longitudinal speed can be aligned with the wheel speed 
information for WSA. 
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[0078] The vehicle 14 does not take off from the road for a 
long period of time; therefore the derivative of the vertical 
velocity of the vehicle should not have significantly low 
frequency contents . It may have high frequency content due to 
road unevenness, but it should have zero value in low 
frequency range for RCA. 

[0079] On level ground the vehicle attitude can be readily 
obtained through the chassis attitude angles, namely, the 
angles calculated from the roll/pitch angular accelerations 
and longitudinal/lateral accelerations for LGAA. 

[0080] In automotive dynamics control, the vehicle absolute 
heading angle is not required. Therefore instead of 

calculating heading angle, the computations are performed in 
the reference frame, which is yawing with the vehicle 14 while 
having an origin still fixed on the earth. The vehicle 14 has 
heading aligned with the reference frame for VHAA. 

[0081] The above alignment conditions (WSA, RCA, LGAA and 
VHAA) provide a set replacement conditions, which otherwise 
are needed from the GPS used in Transfer Alignment. That is, 
they can be used to remove low frequency drift in the sensor 
signals and are thus a GPS -Replacement . 

[0082] The roll/pitch/yaw rates, longitudinal and lateral 
acceleration signals are used to activate the roll stability 
control system, the sensors are not intended to be a strap- 
down IMU sensor cluster 16 because the sensors could be 
mounted on different locations and vertical acceleration 
sensor is missing. While in current strap-down IMU sensor 
setting, the six sensors are arranged orthogonally. That is, 
the orthogonality among angular rate sensors and the 
orthogonality among the acceleration sensors are required. 
With such orthogonality requirements, a set of highly coupled 
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dynamic relationships can be maintained, while in loosely 
arranged sensor configure ration, such a set of highly coupled 
dynamic relationships could be wrong. Also such orthogonally 
arranged sensors help detect the directional and special 
mounting errors, the sensor failures, sensor signal 
conditioning and achieve certain sensor fault tolerance. 

[0083] Referring again to Figures 2, 3, 5, and 6, the 
integrated controller 12 also includes various control units 
controlling the aforementioned sensing algorithms. These 
units may include: a reference signal unit 70 (reference 
signal generator (RSG) ) , which includes an attitude reference 
computation and a velocity reference computation, a road 
profile unit 72 (road profile determination unit (RPD) ) , an 
attitude unit or relative attitude determination unit 74 

(RAD) , a global attitude unit 76 (global attitude 
determination unit (GAD) and a directional unit 78 

(directional velocity determination unit (DVD) ) , a sensor 
plausibility unit 80 (sensor plausibility check unit (SPC)), 
an abnormal state unit 82 (abnormal state monitoring unit 

(ASM) ) , a sensor signal compensating unit 84 (SSC) , an 
estimation unit 86 (force and torque estimation unit (FATE)), 
a normal load unit 90 (normal loading determination unit 

(NLD) ) , and a vehicle parameter unit 92 (vehicle parameter 
determination unit (VPD) ) . Signals generated from any one of 
the aforementioned units are referred to prediction of vehicle 
operation states signals. 

[0084] The integrated controller 12 receives a vehicle dynamic 
signal, such as: a roll rate signal, a pitch rate signal, a 
yaw rate signal, a longitudinal acceleration signal, a lateral 
acceleration signal, and a vertical acceleration signal from 
the sensor cluster 16 and other signals from other vehicle 
sensors, and generates a vehicle reference velocity signal and 
various other control signals in response thereto, such as an 
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estimate of vehicle operation states signal and a prediction 
of vehicle operation states signal. 

[0085] The system 10 includes the sensor cluster 16, wheel 
speed sensors 24, steering angle sensors 26 (SWA), suspension 
height sensors 30, and local sensors 32 used by the subsystem 
controls . Such sensor sets cover almost all existing vehicle 
control functions. As an illustrative example, the yaw 
stability control 40 uses only a portion of the sensors from 
the system sensor set, such as those generating 4 -wheel drive 
reference signals from the reference signal unit 70 and side 
slip angle computations from the directional unit 78. 

[0086] The sensor cluster 16, within the housing 45, includes 
a vehicle dynamic sensor, such as: a roll rate sensor 47 
generating a roll rate signal, a pitch rate sensor 48, 
generating a pitch rate signal, a yaw rate sensor 50 
generating a yaw rate signal, a longitudinal acceleration 
sensor 52 generating a longitudinal acceleration signal, a 
lateral acceleration sensor 54 generating a lateral 
acceleration signal, and a vertical acceleration sensor 56 
generating a vertical acceleration sensor 56 generating a 
vertical acceleration signal. 

[0087] The sensor cluster 16 is mounted on the center of 
gravity of the vehicle 14 (or mounted on any location of the 
vehicle 14 that can be transformed into the center of gravity 
of the vehicle 14), the wheel speed sensors 24 are mounted at 
each corner of the vehicle 14, and the rest of the sensors are 
mounted on their respective locations in the vehicle 14. 

[0088] As was previously mentioned, the sensor cluster 16 
includes three gyros 47, 48, 50 and three linear 
accelerometers 52, 54, 56. The three gyros 47, 48, 50 and 
three linear accelerometers 52, 54, 56 in the sensor cluster 
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16 are calibrated and mounted along the vehicle body- fixed 
directions, jc, y and z 

[0089] The angular rate outputs of the sensor cluster measure 
the car body angular rates along the body- fixed axes and are 
denoted about their respective axes as CO x for the roll rate, 

C0 y for the pitch rate and co z for the yaw rate. The 

acceleration outputs from the sensor cluster 16 are measures 
of the car body directional accelerations along the body-fixed 
axes and are denoted about their respective axes as a x for 
longitudinal acceleration, a y for lateral acceleration and a z 
for vertical acceleration. 

[0090] The roll, pitch and yaw attitude angles of a vehicle 14 
are related to the roll angular rate, pitch angular rate and 
yaw angular rate sensor signals through coupled interactions, 
rather than simple integrations and differentiations. Simple 
integrations work when the different motions of the vehicle 14 
are decoupled. In general, complicated relationships exist 
among the vehicle attitudes and the angular rates . 

[0091] In the present invention, reference attitudes are 
obtained through a road constraint. The road constraint 
considered here is based on the inference that, on average, 
the vehicle is driven on the road (which could be 3- 
dimensional ) , and the vehicle 14 contacts the road and has a 
small take-off velocity. This road constraint does not 
exclude the potential vehicle take-off velocity due to road 
unevenness (for example, bumps) causing vehicle heave 
vibrations. The average vehicle heave velocity, however, is 
around zero; and the low frequency portion of the vehicle 
heave velocity is zero. This unique operating condition for 
automotive vehicles helps eliminate the need for external 
sources like GPS to calculate reference attitudes. 
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[0092] Due to the road constraint, a reference attitude can be 
calculated based on the aforementioned three accelerometer 
outputs and the three angular rate outputs from the sensor 
cluster, the vehicle reference velocity calculated from the 
wheel speed signals, the steering angle, together with the 
vehicle dynamics model. Such computations are performed in a 
reference signal generator unit 70, which generates the 
reference signal therefrom. The vehicle reference velocities 
include longitudinal reference velocity, lateral reference 
velocity or a side-slip angle. 

[0093] Because of the relationships between the sensor 
signals, the sensor mounting errors can also be corrected 
within the controller 12. For example, the pitch misalignment 
of the sensor cluster can be calculated as in the following 

A# y = sin" 1 

where 

Ar = a xs +<D zs v y +gsin(0 ySN ) 

A y = a v ~ ^xsVy + 8 <X>S(e yS/i ) 

and and v x is the vehicle longitudinal and lateral 

velocities calculated on the road frame. For example, v x can 

be calculated based solely on the wheel speed signals, can 

be calculated based on a linear bicycle model of the vehicle. 
In this case, the above computation will be conducted 
conditionally: for example, the vehicle is driven straight 
with deceleration or acceleration. 

[0094] Similar misalignment or mounting errors of the other 
sensors are also performed. The sensor information is then 
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used to conduct real-time calibration for sensor signals. For 
example, the rolling radius calibration for wheel speed 
sensors can be performed based on the available sensor signals 
and the calculated signals. Those computations are conducted 
at the sensor compensation unit or sensor signal unit 84, 
which generates a sensor compensation signal therefrom. 

[0095] The sensors also provide information for estimating and 
predicting the road profile, the road surface and the road 
curvatures. Such computations are conducted in the road 
profile unit 72, which generates a road profile signal 
including but not limited to surface friction level, surface 
unevenness (roughness) , road inclination and bank angle, 
therefrom. 

[0096] The abnormal conditions of the vehicle also detected 
and monitored in the system. These abnormal conditions 
include tire under-inf lation, tire imbalance, actuator 
failure, wheel lifting, etc. Such functions are performed in 
an abnormal state unit or abnormal state monitoring unit 82, 
which generates the abnormal state signal therefrom. 

[0097] The forces and torques applied to the wheels play 
important roles in many vehicle control functions. The system 
10 also conducts estimation of and prediction of those 
loadings in an estimation unit or force and torque unit or 
force and torque estimation unit 86 (FATE) , which generates 
the force and torque signal therefrom. 

[0098] The reference attitude signal obtained based on all the 
sensor signals and the road constraint assumption is 
calculated and then used to correct the attitude computation 
errors . 

[0099] Besides the sensor cluster 16, the system 10 also 
includes wheel speed sensors 24, a wheel steering angle sensor 
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26, suspension height sensors, and any actuator specific 
sensors 32 (for example, the brake pressure sensors and all 
the other sensors which are used for subsystem controls). 
Therefore the system provides the vehicle operation states, 
such as: vehicle attitudes with respect to the average road 
surface, vehicle directional velocity, road profile and 
surface conditions, traction forces, and tire forces. 

[00100] Another aspect of the system 10 is the ability to 
conduct sensor plausibility checks, sensor error compensation, 
and abnormal vehicle state monitoring and detection because 
all the sensor signals are available to the system 10 . Many 
of the sensor signals have cross influences over other sensor 
signals, and there are interconnecting relationship among all 
the sensor signals . 

[00101] The dynamic system controller 33 receives the vehicle 
reference velocity signal and generates a dynamic control 
signal in response thereto. The dynamic system controller may 
include a yaw stability controller 40, a roll stability 
controller 42, an ABS controller 44, or a TCS controller 46, 
or any combination thereof either separate or together in a 
single dynamic system unit. 

[00102] The braking system controller 34 or safety device 
controller/vehicle safety system receives the dynamic control 
signal and generates a braking signal in response thereto. 
The braking system controller 34 includes control function 
priority/arbitration/integration logic 35 and brake 
communicating and brake command controllers 37. 

[00103] The braking system controller 34 receives at least one 
of a plurality of signals including: the road profile signal, 
the vehicle attitude signal, the global position signal, the 
vehicle direction signal, the sensor plausibility signal, the 
abnormal state signal, the mounting sensor error correction 
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signal, and the force and torque signal. In one embodiment of 
the present invention, the braking system controller 34 checks 
the vehicle reference velocity signal with the at least one of 
the plurality of signals. In alternate embodiments, the 
braking system controller 34 predicts future vehicle states 
from at least one of the aforementioned signals and activates 
safety devices in response thereto. 

[00104] The various alternate known actuators 36 include 
active steering systems, active braking systems, active 
transmission systems, drive-train • controls, power- train 
controls, throttle controls, controllable suspensions, 
controllable anti-roll-bar, etc. The actuators 36 are 

activated in response to the signals generated from the 
integrated system controller 12 . 

[00105] Referring to Figure 7, a logic flow diagram 200 of a 
method for controlling a vehicle dynamic system, in accordance 
with another embodiment of the present invention, is 
illustrated. Logic starts in operation block 2 02, where the 
vehicle 14 experiences an RSC event. The sensors within the 
sensor cluster 16 respond to RSC event data by generating 
sensor signals, as was previously discussed. In operation 
block 204, the sensor cluster signals and various other 
vehicle sensor signals are received in the integrated system 
controller 12 . 

[00106] In operation block 206, the integrated system 
controller 12 estimates current vehicle states and predicts 
future vehicle states in response to the RSC generated sensor 
signals. 

[00107] In operation block 208, a dynamic system controller 33 
receives the integrated system controller signals and 
generates therefrom stability control signals. 
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[00108] In operation block 210, the braking controller 34 
receives the dynamic system controller signals and generates 
therefrom braking signals. In response thereto, in operation 
block 212, vehicle actuators 36 and vehicle systems are 
activated to respond to or compensate for the RSC event. In 
operation block 214, the vehicle actuators 36 and systems 
compensate for the RSC event and attempt to stabilize the 
vehicle 14. 

[00109] In operation, one method for controlling a safety 
device for a vehicle includes generating a roll attitude angle 
of a sensor frame with respect to an intermediate axis system; 
generating a pitch attitude angle of the sensor frame with 
respect to the intermediate axis system; generating an x 
velocity component of the sensor frame with respect to the 
intermediate axis system; generating a y velocity component of 
the sensor frame with respect to the intermediate axis system; 
generating a z velocity component of the sensor frame with 
respect to the intermediate axis system; transferring the roll 
attitude angle, the pitch attitude angle, the x velocity 
component, the y velocity component, and the z velocity 
component in the sensor frame to a body fixed frame system as 
a function of sensor misalignments. 

[00110] In operation, another method for controlling a safety 
device for a vehicle includes, transforming vehicle dynamic 
variables from a sensor frame to a body frame as a function of 
vehicle dynamic sensor misalignments; generating a roll 
attitude angle of the body frame with respect to an 
intermediate axis system; generating a pitch attitude angle of 
the body frame with respect to the intermediate axis system; 
generating an x velocity component of the body frame with 
respect to the intermediate axis system; generating a y 
velocity component of the body frame with respect to the 
intermediate axis system; and generating a z velocity 
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component of the body frame with respect to the intermediate 
axis system. 

[00111] The methods also include generating an attitude 
reference computation, generating a road profile signal, 
generating a vehicle attitude signal, generating a global 
position signal, generating a vehicle direction signal, 
generating a sensor plausibility signal, generating an 
abnormal state signal including information regarding abnormal 
vehicle conditions, generating a mounting sensor error 
correction signal, generating a force and torque signal in 
response to forces . and torques applied to the vehicle, 
generating a body fixed frame to roll frame signal, generating 
a normal load signal, generating a vehicle parameter signal, 
and generating the safety device control signal in response to 
a combination of the attitude reference computation, the road 
profile signal, the vehicle attitude signal, the global 
position signal, the vehicle direction signal, the sensor 
plausibility signal, the abnormal state signal the mounting 
sensor error correction signal, and the force and torque 
signal . ' . 

[00112] While particular embodiments of the invention have 
been shown and described, numerous variations and alternate 
embodiments will occur to those skilled in the art. 
Accordingly, it is intended that the invention be limited only 
in terms of the appended claims. 



30 



